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Prufungsantrag gem. § 44 PatG ist gestellt 

® Verfahren und.Vorrichtung zur Regelung der Vorhalteposition eines Manipulators eines Handhabungsgerats 

@ Die Effindung betrifft ein Verfahren zur Regelung der 
Vorhalteposition eines in mehreren Freiheitsgraden be> 
wegbaren Manipulators (2) eines Handhabungsgerats (1) 
relativ zu einem Objekt (3) entlang einer Verfahrbahn. Um 
eine schneliere Regelung der Vorhalteposition zu ermog- 
lichen, wird vorgeschiagen, dass mehrere Punkte zumrh- 
dest eines Teils der tst-Verfahrbahn gespeichert sind und 
fur eine vorausschauende Regelung der Vorhaltepoisition 
des Manipulators (2) entlang dieses Teils der Verfahrbahn 
herangezogen werden. 
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Beschreibung 

Die vorliegende Erfinduag betrifft ein Verfahren und eine 
Voirichtung zur Regelung der Vorhalteposition eines in 
mehieien Freiheitsgraden bewegbaren Manipulators eines 5 
Handhabungsgerats relativ zu einem Objekt entlang einer 
Verfahrbahn. Die Brfindung betriflt auBerdem ein H^dha- 
bungsgeiat mil einem in mehreren Freiheitsgraden beweg- 
baren Manipulator, dessen V:>ifaalteposition leladv zu einem 
Objekt regelbarist 10 

Das Handhabungsgerat ist bspw. als ein mehigelenkiger 
Industrie-Roboter ausgebildet Derartige Industrie-Roboter 
werden insbesondere in der Automobilindustrie in der Feiti- 
gung und der Qualitatssicherung eingesetzt Flir (tie unter- 
schiediichen Einsatzmdglichkeiten eines Industrie-Roboters 15 
kann der Manipulator beliebig ausgebildet sein. 

Der Manipulator ist bspw. als ein Werkzeug, insbesondere 
als ein SchweiBgerat, als ein Gerat zum Auftragen von 
Klebstofif, von Farbe oder von anderen Beschichtungen auf 
eine Oberflache, als ein Bearbeitungsgerat o. a. ausgebildeL 20 
Zum Ecgreifen eines oder mehrerer Objekte kann der Mani- 
pulator als ein Greifer, ein Saugnapf o. a. ausgebildet sein. 
Schliefilich ist es denkbar, dass der Manipulator als ein 
Messkopf z. B. zum Messen des Oberflacheaverlaufs eines 
Objekts, einer Spaltbreite, eines Spaltversatzes, einer 25 
Schichtdicke o. II. ausgebildet ist. 

Damit der Manipulator die ihm zugedachte Aufgabe er- 
fullen kann, muss er in einedefinierte Vorhalteposition rela- 
tiv zu einem Objekt gebracht werden, Unter dem BegrifF 
Vorhalteposition wird gemaS dem vorliegenden Patent so- 30 
wohl die Positionierung als auch die Ausrichtung des Mani- 
pulators relativ zu dem Objekt verstanden. 

Aus dem Stand der Technik sind Handhabungsgerate be- 
kannt, die eine interne Steuerungseinrichtung aufweisen. 
Auf der Steuerungseinrichtung ist ein Steuerungsprogranun 35 
lauil^g, durch das der Manipulator endang einer program- 
mierten Verfahrbahn in die VoAalteposition bewegt werden 
kann. Wenn das Objekt stets an derselben Position angeord- 
net ist, reicht eine solche Steuerung der Verfahibahn bis zur 
Vorhalteposition vollkommen aus. Falls die Posidon des 40 
Objekls jedoch gewissen Schwankungen unterworfen ist, 
was der Regelfall ist, kann durch eine Steuening aileine 
nicht mehr sichergestellt werden, dass eine bestimmte \br- 
halteposidon des Manipulators relativ zu dem Objekt stets 
mit der erforderlichen Genauigkeit eingenonunen winL 45 
Schwankungen der Position des Objekts konnen yielerlei 
Ursachen haben. 

Um sicherzustellen, dass die Vorhalteposition des Mani- 
pulators relativ zu dem Objekt auch bei Schwankungen der 
Position des Objekts stets mit der geforderten Genauigkeit 50 
eingenonunen wird, ist es aus dem Stand der Ibchnik eben- 
falls bekannt, die \brhalteposition des Manipulators relativ 
zu dem Objekt zu regeln. Aus dem Stand der Ibchnik sind 
unterschiediiche Verfahren zur Regelung der Vorhaltepos- 
ition des Manipulators bekannL Diese bekannten Verfahren 5S 
zur Regelung der Voriialteposition sind jedoch sehr kompli- 
ziert und langsam. 

Im Rahmen der Regelung der Vorhalteposition des Mani- 
pulators relativ zu einem Objekt wird die Ist- Vorhaltepos- 
ition des Manipulators zunachst mittels Sensoren erfasst und 60 
dann auf eine Soil- Vorhalteposition geregelL Die Sensoren 
sind bspw. als optische oder als taktile Sensoren ausgebildet. 

Insbesondere sind sie als Laser-Sensoren zum Messen 
von Abslanden, als Kraft/Momenten-Sensoren zum Messen 
von Kraften bzw. Momenlen qder als Beriihrungssensoren 65 
zur Detektion einer Beriihrung mit dem Objekt ausgebildet. 

Die Sensoren sind in einem bestimmten Bezug (Position 
und Ausrichtung) zu dem Manipulator angeordneL M>r der 
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Regelung der \brhalteposition mussen die Sensoren in ei- 
nen konkreten Bezug zu dem Manipulator und zu dem Ob- 
jekt gebracht werden (Einrichten) und die Parameter der Re- 
gelung an den konkreten Bezug angepasst werden (Kalibrie- 
ren). Der Bezug der Sensoren zu dem Manipulator kann sich 
aufgrund von Temperaturschwankungen, mechanischen 
Einwirkungen auf die Sensoren oder den Manipulator, p. a. 
verandem, wodurch ein emeutes Kalibrieren und u. U. sogar 
eine emeutes Hnrichten der Vbrrichtung zur Durchfuhrung 
dor Regelung notwendig wird. WShrenddes Binrichtens und 
KaUbrierens steht die Vordchtung nicht fiir eine Regelung 
zur Verfugung, die Regelung der M^rhalteposition muss un* 
terbrochen werden. 

SMmtliche bekannten Verfahren zur Regelung der Vorhalt- 
eposition des Manipulators haben auBerdem den Nachteil, 
dass die Verfahrgeschwindigkeit des Manipulators relativ 
klein ist, da die Regelung in Unkenntnis der bevorstehen- 
den, zu regelnden Verfahrbahn des Manipulators erfolgt 
Deshaib muss die Verfahrgeschwindigkeit so klein gewahlt 
werden, dass auch im Extiemfall einer Verfahnichtungsum- 
kehr eine rasche und genau Positionierung des Manipulators 
sicheigestellt werden kann. Bei einer zu hohen ^ferfahrge- 
schwindigkeit wurde der Manipulator bei stark gekrummten 
Verfahrbahnen oder einer Verfahrrichtungsumkehr aufgrund 
der Massentragheit uber die geregelte Verfahrbahn hinaus- 
schieBen und somit die geregelte Verfahrbahn verlassen. 

Es ist deshaib eine Aufgabe der vorliegenden Erfindung, 
ein Verfahren der eingangs genannten Art dahingehend aus- 
zugestalten und weiterzubilden, dass eine moglichst 
schnelle Regelung der Vorhalteposition erreicht und dass 
insbesondere hohere Verfahrgeschwindigkeilen des Mani- 
pulators auf der Verfahrbahn realisiert werden konnen, ohne 
dass es zu einem Verlust an Regelungsgenauigkeit kommt. 

Zur Losung dieser Aufgabe schlagt die Erfindung ausge- 
hend von dem Verfahren der eingangs genannten Art vor, 
dass mehrere Punkte zumindest eines Teils der Ist- Verfahr- 
bahn gespeichert sind und fiir eine vorausschauende Rege- 
lung der Vorhalteposition des Manipulators entlang dieses 
Teils der Verfahrbahn herangezogen werden. 

ErfindungsgemaB ist erkannt worden, dass die Regelung 
der Vorhalteposition durch eine vorausschauende Regelung 
auf einfache Weise entschddend beschleunigt werden kann. 
Wahrend der vorausschauenden Regelung der \brhaltepos- 
ition wird der bevorstehende Verlauf der Verfahrbahn be- 
riicksichtigt, Wenn der bevorstehende Verlauf der Verfahr- 
bahn es zulasst, bspw, bei einer geraden oder einer nur ge- 
ringftigig gekrummten Verfahrbahn, kann die Verfahrge- 
schwindigkeit des Manipulators hoch gewahlt werden. Da- 
durch kann die Regelung der Vorhalteposition entlang einer 
Verfahrbahn entscbeidend beschleunigt werden. Bei zuneh' 
mender KrUmmung der bevorstehenden Verfahrbahn muss 
die Verfahrgeschwindigkeit zunehmend reduztett werden. 
Durch die Wahl einer geringen Verfahrgeschwindigkeit bei 
starken Krummungen der bevorstehenden Verfahrbahn kann 
zudem (He Genauigkeit der Regelung der \Ualte^x>sition 
des Manipulators endang der Verfahrbahn entscbeidend er- 
hdht werden. Bei dem crUndungsgemaBen Verfahren kann 
die Verfahrgeschwindigkeit soirut dem Verlauf der bevorste- 
henden Verfahrbahn individuell angepasst werden. 

Die Punkte der Ist- Verfahrbahn konnen auf unterschiedii- 
che Weise, z, B. empirisch, simulativ oder durch Berech- 
nung, bestiirunt werden. Bei der empirischen Bestimmung 
der Punkte der Ist- Verfahrbahn konnen die einzehien Punkte 
entweder mit dem Manipulator des Handhabungsgerats ma- 
nucU oder von einer ersten Steuercinrichtung gesteueit an- 
gefahren werden. Bei der simulativen Bestimmung der 
Punkte wird zunachst ein Modell des Handhabungsgerats 
und des Objekts, vorzugsweise auf einem Computer, er- 
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stellt. Anhand dieses Modells wird dann durch Simulation 
der Veifahrbahn die Ist-Verfahrbahn bestimmt Bei der ma- 
thematischea Bcrechnung der Punkte der Ist-Verfahrbahn 
wird zunachst ein raathematiscbes Model! des Handha- 
bungsgerats und des Objekts erstellt, und die Puhkte werden 
dann durch Losen mathemadscher Gleichungen berechnet 

GemaB einer vorteilhaften Weiterbildung der voriiegen- 
den Erfindung wird voigeschlagen, dass die 1st- Verfahibabn 
des Manipulators vor der Regelung der Vorhalteposition ab- 
gefahren wird und dabei die Punlcte zuiiundest eines Ibils 
der Ist-Verfahibahn aufgenommen und abgespeichert wer- 
den. Die Ist-Verfahrbahn muss nidit mit besonders hohen 
Anforderungen an die Genauiglceit abgefohren werden, da 
die Verfahibahn ira Rahmen der nachfotgenden Regelung 
der Verfahfbahn des Manipulators korrigiert werden kann. 
Die abgefahrene Ist-Verfahrbahn stellt lediglicb eine Ab- 
schatzung des Verlaufs der SolUVofahrbahn dar und muss 
so genau sdn, dass sie fUr eine vorausschauende Regelung 
der Vorhalteposition des Manipulators entlang der \ferfahr- 
bahn herangezogen werden kann. 

Die Ist-Verfahrbahn wird vorteilhafterweise von dem Ma- 
nipulator vor der Regelung der Vorhalteposition von einer 
intemen Steuerungseinrichtung des Handhabungsgerats ge- 
steuert abgefahren. Auf der intemen Steuerungseinrichtung 
iSuft ein Steueningsprogramm ab, in dem die einzelnen 
Punkte der Ist-Verfahrbahn programmieit sind. Das Steue- 
rungsprogranim steuert das Handhabungsgerat derart an, 
dass der Manipulator wShrend des Ablaufs des Steuerungs- 
programms die Ist-Verfahrbahn abfahrt Dabei werden die 
Punkte zumindest eines Teils der Ist-Verfahrbahn aufge- 
iK}nunen und abgespeichert. AuBerden in d^ Steuerungs- 
programm progranunierten Punkten der Ist-Verfahrbahn 
konnen noch zusatzliche Punkte d^ Ist-Verfahrbahn aufge- 
zx>mmen und gespeichert werden. 

Die Punkte zumindest eines Teils der Ist-Verfahrbahn 
werden voizugsweise von einer extemen Regelungseinrich- 
tung aufgenonunen und abgespeichert. Auf der extemen Re- 
gelungseinrichtung lauft ein Regelungsprogramm ab, das 
die Vorhalteposition des Manipulators auf der Verfahrbahn 
regelL Die exteme Regelungseinrichtung ist bspw. als ein 
Personal Computer (PC) oder als ein Industrie-PC ausgebil- 
det Das Regelungsprogramm kann in einer StandardrPro- 
grammiersprache pr<^rammiert und dine gro8en Aufwand 
umprogrammiert werden. In einem bestinmiten Modus (Re- 
cord-Mode) vor der Regelung der Vorhalteposition kann das 
Regelungsprogramm auch die Punkte der von dem Manipu- 
lator abgefahrenen Ist-Verfahrbahn aufnehmen und abspei- 
chem. Die gespeicherten Punkte werden dann in einem an- 
deren Modus (Operation-Mode) fur die vorausschauende 
Regelung der Nfortialteposition herangezogen. 

Gemafi einer anderen vorteilhaften Weiterbildung der 
vorliegenden Erfindung wird vorgeschlagen, dass die ex- 
teme Regelungseinrichtung von der intemen Steuemngsein- 
ricfatung aufgerufen wird. Das Steuerungsprogramm der in- 
temen Steuemngseinrichtung ist iiblicherweise in einer pro- 
prietaren, nur auf der Steuerungseinrichtung eines bestimm- 
ten Handhabungsgerats lauffahigen Programmierungsspra- 
che programmiert Es ware nur mit einem groBcn Aufwand 
moglich, das gesamte Regelungsprogramm in das Steue- 
rungsprogramm zu integrieren. Deshalb sind in dem Steue- 
rungsprogramm bestimmte Programmierbefehle (Aufrufbe- 
fehle, Ruckholbefehle) voigesehen, urn das Regelungspro- 
gramm der extemen Regelungseinrichtung von dem Steue- 
rungsprogramm aus aufzurufen. Das Einfugen dieser Pro- 
grammierbefehle in das Steuerungsprogramm ist mit einem 
geringen Aufwand moglich. Je nach dem in welchem Mo- 
dus die Regelung betrieben wird, werden durch einen Auf- 
ruf des Regelungsprogramms der Regelungseinrichtung die 



4 

Punkte der Ist-Verfahrbahn aufgenommen und gespeichert 
(Record-Mode) oder die Vorhalteposition vorausschauend 
geregelt (Operation-Mode). 
In einer anderen vorteilhaften Weiterbildung der Erfin- 
5 dung wird vorgeschlagen, dass vor der Regelung der Vor- 
halteposition die Soll-\brhalteposition des Manipulators an- 
gefahren wird, wahrend einer Vcranderung der Soli- Vorhalt- 
eposition um jeweils einen Freiheitsgrad Messdaten, durch 
die die Vorhalteposition des Manipulators charakterisiert ist, 

10 aufgenonunen und gespeichert werden und die Regelung 
der Voifaalteposidon in Abhangigkeit von den Messdaten 
diirchgefuhrt wir± Zwischen den aufgenommenen Messda- 
ten und der Position des Manipulators besteht ein Zusam- 
menhang. Somit sind in den aufgenominenen Messdaten In- 

15 formationen iiber die Position des Manipulators enthalten. 
Die Soli- Vorhalteposition wird in einem weiteren Modus 
(Parameter-Mode) vor der Regelung der Vbrhalteposition 
angefahren. Zum Anfahren der Soil- Vorhalteposition im Pa- 
rameter-Mode werden die im Record-Mode gespeicherten 

20 Punkte der Ist-Verfahrbahn herangezogen. Sobald die SoU- 
\brhalteposition erreicht ist, beginnt eine Trainingsphase, in 
der fur die spatere, im Rahmen des Operation-Mode durch- 
geflihrte Regelung der Vorhalteposition benddgte Informa- 
tionen ermittelt werden. 

25 wahrend der IVainingsphase wird der Manipulator um 
die Soll-Vszhalteposition um jeweils dnen Freiheitsgrad in 
untorschiedliche Vorhaltepositionen relativ zu dem Objekt 
bewegt Der Manipulator wird um jeden Freiheitsgrad in - 
Vorhaltepositionen bewegt, die vorzugsweise zu beiden Sei- 

30 ten der Soll-\brhalteposition liegen. Die Vorhaltepositionen 
des Manipulators werden durch Sensoren ermittelt, die vor- 
zugsweise an dem Manipulator befestigt sind Die Sensoren 
liefem Messdaten anhand derer eine Vorhalt^sition des 
Manipulators charakterisiert ist Die Messdaten sind bspw. 

35 die Abstande von den Sensoren zu dem Objekt, Krafte oder 
Momente, die von dem Objekt auf die Sensoren einwirken. 
Die Messdaten konnen auch Bildmessdaten sein, Bildmess- 
daten werden durch Vermessen von Bildem gewonnen, die 
von einer CCD-Kamera o. a. aufgenommen wurden. Im 

40 Rahmen der Trainingsphase werden die Messdaten fUr jeden 
der Freiheitsgrade fur jede der \^rhalteposidonen aufge- 
nommen. Es ist denkbar, dass die gespeicherten Messdaten 
fiir die Regelung der Vorhalteposition weiterveratbdtet wer- 
den. Dann ist die IVaining^ase ftir diese Soll-Vbrhaltepos- 

45 ition abgeschlossen. Der Manipulator kann eine weitere 
Soil- Vorhalteposition anfahren und fiir diese Soil- Vorhalt- 
eposition eine weitere Trainingsphase durchlaufen, bis alle 
Soll-Vorhaltepositionen angefahren worden sind. Dann ist 
der Parameter-Mode abgeschlossen. Die spatere, im Rah- 

50 men des Operation-Mode durchgefulute Regelung der \for- 
halteposition wird in Abhangigkeit von den gespeicherten 
Messdaten durchgeftihrt 

Bei dem erfindungsgemaSen >^rfahren ersetzt die Trai- 
ningsphase das bei herkommlichen, aus dem Stand der 

55 Technik bekannten Verfahren zum Regeln der \brhaltepos- 
ition des Manipulators eines Handhabungsgerats notwen- 
dige Eixuichten (Positionierung der Sensoren relativ zu dem 
Objekt) und Kalibrieren (Einstellen der Parameto: der Rege- 
lung). 

60 Auch bei diesem Verfahren, bei dem vor der Regelung der 
Vorhalteposition eine IVainingsphase durchlaufen wird, 
werden mehrere Punkte zumindest eines Teils der Ist-Ver- 
fahrbahn gespeichert und f\k eine vorausschauende Rege- 
lung der Vorhalteposition des Manipulators entlang dieses 

65 Teils der Verfahrbahn herangezogen. Das Durchlaufen einer 
Trainingsphase vor der Regelung der Vorhalteposition hat 
die angegebenen Vorteile aber auch ohne diese Merkmale 
des Kennzeichens des Patentanspruchs I. Der Schutz des 
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Patents soli sich deshalb auch auf ein \ferfahren der zuietzt 
genannten Ait beziehen, bei dem die im Kennzeichen des 
Patentanspnjchs 1 genannten M^kmale fehlea 

GcmaB eincr bevorzugten Ausfuhrungsform der vorlic- 
genden Erlindung wird voigeschlagen, dass vor der Rege- 
lung der \^rhakeposition 

- die SoU-Varbalteposition angefabren wild, 

- ein SoU-Messvektor mit den Messdaten aufgenom- 
men wird, 

- fiir jeden Freiheitsgrad der Manipulator des Handha- 
bungsgerats aus der SollrVorfaalteposidon heraus in 
mehrere Vorhaltepositionen bewegt uhd in jeder Vor- 
halteposition ein Messvektor aufgenonimen wird, 

- fiir jeden Freiheitsgrad. fur dieselben Messdaten der 
Messvektoren der Betrag des Gradienten ennitteLt und 
in dner Gradientenmatrix gespeichert wird, und im 
Rahmen der Regelung der Vorfaalteposition 

- ein Korrekturvektor aus der Multiplikation des 
Kehrwerts der Gradientenmatrix mit der Diffeienz des 
SoU-Messvektors und eines Ist-Messvektors in der Ist-. 
Vorfaalteposition des Manipulators oder anhand eines 
ahdeien geeigneten Verfahrens ermittelt wird und 

- die Vorfaalteposition in Abhangigkeit von dem Kor- 
rdcturvektor geiegelt wird 

GemaB dieser bevorzugten Ausfuhrungsfoim werden in 
der TVainingsphase im Parameter-Mode die fiir die Soll-\fer- 
halteposition aufgenonunenen Messdaten in einem Soil- 
Messvektor und die Messdaten, die fiir im Rahmen der Trai- 
ningsphase angefahrene Vorhaltepositionen aufgenommen 
wurden, in Messvektoren gespeichert Fiir jeden Freiheits- 
grad, urn den Manipulator bewegbar ist, werden also von 
der Soli- Vorfaalteposition aus mehrere Vorhaltepositionen in 
jede Richtung angefahien und in jeder V:>rhalteposition ein 
Messvektor aufgenommen. Die Dimension der Messvekto- 
ren entspricht der Anzafai der fur jede Vorfaalteposition auf- 
genonunenen Messdaten. Die Dimension aUer Messvekto- 
ren ist gleich groB. 

FOr jeden Fieihdtsgrad weiden die Messvektoren und der 
SoU-Messvektor dann weiterverarbeitet Aus denselben 
Messdaten der Messvektoren eines Frdheitsgrades wird der 
Betrag des Gradienten ermittelt und in einer Gractiehtenma- 
trix gespeichert Die Gradientenmatrix hat somit die Dimen- 
sioncn (Anzahl der fiir jede Vorfaalteposition aufgenonune- 
nen Messdaten) x (Anzahl do- Frciheitsgrade). Es ist denk- 
bar, den Kehrwert der Gradientenmatrix beceits in dem Pa- 
rameter-Mode zu berecfanen und abzuspeichem. Vorzugs- 
weise wird cr aber erst in dem nachfolgenden Operation- 
Mode b^^echnet Damit ist die IVainingsphase fur diese 
SoU-Vorhalteposition abgescfalossen. Die Gradientenmatnx 
kann auch als Jakobimatrix oder als Sensibilit^ltsmatrix be- 
zeichnet werden. 

Im Rahmen des Operation-Mode wird dann ftir die Rege- 
lung der Vorfaalteposition des Manipulators ein Ist-Mess- 
vektor ermittelt, d. h. es werden die Messdaten in der tno- 
mentanen V>rhalteposition des Manipulators des Handfaa- 
bungsgerats ermittelt und in dem Ist-Messvektor gespei- 
chert Dann wird ein DifTerenzvektor aus der Differenz des 
Soll-Messvektors und des Ist-MessvektoR gebildet Des 
Weiteren wird der Kehrwert der Gradientenmatrix berechnet 
und wahlweise abgespeichert, 

Schliefilich wird ein Korrekturvektor aus der Multiplika- 
tion des Kehrwerts der Gradientenmatrix mil dem Diffe- 
renzvektor berechnet und die Vorfaalteposition in Abhangig- 
keit von dem Korrekturvektor geregelt 

Der Korrekturvektor kann aucfa mittels eines anderen ge- 
eigneten Verfahrens besUmmt werden, bspw. durcfa den Ein- 



satz eines sequentiellen Kalmanfilters. Derartige geeignete 
Verfahren zum Berecfanen des Korrekturvektors sind aus 
dem Stand der Ibchnik bekannt und konnen von einem 
Fachmann nach Beliebcn eingesetzt werden. Diese anderen 
5 geeigneten Verfahren faaben den Vorteii, dass auf eine relativ 
aufwendige Bildung des Kefafwerts der Gradientenmatrix 
verzichtet werden kann. 

Wafarend des Operation-Mode fafart der Manipulator zu- 
nachst die Verfahrbahri gemSfi den wafarend des Record- 

10 Mode gespeicherten Punkten ab. Diese Verfafarbafan wird 
dann im Rahmen der Regelung der \^halteposition des Ma- 
nipulators mit Hilfe des Korrekturvektors korrigiert. Bei 
dem erfindungsgemafien Verfahren wird die \brhaltepos- 
ition also nicfat absolute sondem lediglicfa relativ zu einer 

15 Vorfaalteposition auf der gespeicherten Verfahrbahn gere- 
gelt 

Vorteilhafterweise wird die Est- Vorfaalteposition im Rah- 
men der Regelung der Vorfaalteposition um einen Bnicfateil 
des Korrekturvektors korrigiert und anschliefiend der Ist- 

20 Messvektor in der korrigierten Istr Vorfaalteposition und dar- 
aus der Korrekturvektor emeut ermittelt Die Ist- Vorfaalt- 
eposition wird also nicfat um den gesamten Korrekturvektor 
korrigiert Um ein Uberschwingen der Regelung zu verfain- 
dem, wird vielmehr versucfat, sich der Soll-\brhalteposition 

25 langsam von einer Richtung her anzunShem. Dadurch wird 
eine Regelung mit e'mem gedampften Binscfawingverhalten 
realisiert Durcfa eine geeignete Wahl des Bruchteils des 
Korrekturvektors kann die Dampfungskonstante der Rege- 
lung bestimmt werden. 

30 Die Regelung der Vorfaalteposition wird vorzugsweise ab- 
gebrochen, wenn jedes der Elcmente des Korrekturvektors 
kleiner als ein Abbruchkriteriura ist Durcfa eine geeignete 
Wahl des Abbruchkriteriums kann einerseits die Genauig- 
keit der Regelung und andererseits die Regelungsgescfawin- 

35 digkeil bestimmt werden. Je kleiner der Wert des Abbruch- 
kriteriums gewafalt wird, desto genauer kann die Regelung 
der Vorfaalteposition durcfagefuhrt werden, Ein kleiner Wert 
des Abbruchkriteriums bedeutet jedoch aucfa, dass die Rege- 
lung mehr Zeit bendtigt, bis das Abbruchkriterium erftillt 

40 ist 

Um eine Regelbarkeit der >^rhalteposition des Manipula- 
tors innerfaalb eines bestimmten Arbeitsvolumens der Rege- 
lung sicherzustellen, sollten die aufgenonunenen Messvek- 
toren nach Moglichkeit das gesamte Arbeitsvolumen abdek- 

45 ken. Des Weiteren sollten fur jeden Freiheitsgrad so viele 
Messvektoren aufgenonmien werden, dass eine zuveriassige 
Berechnung des Betrags des Gradienten der Messdaten 
mogiicfa ist. Desfaalb wird gemSB einer bevorzugten Ausfiih- 
rungsform der Erfindung vorgescfalagen, dass fUr jeden Frci- 

50 heitsgrad von der Soil- Vorfaalteposition aus mindestens zwei 
Messvektoren in jede Ricfatung aufgenommen werden. Vor- 
teilfaafterweise wo-den jedocfa fur jeden Freiheitsgrad von 
der Soll-Vbrhalteposition aus funf Messvektoren in jede 
Richtung aufgenommen. Somit ergeben sich fur jeden Frei- 

55 heitsgrad zehn Messvektoren und der Soll-Messvektoi; also 
elf Messvektoren. Fur jedes der aufgenommenen und in den 
Messvektoren gespeichette Messdatum wird dann der Be- 
trag des Gradienten betecfanet und in der Gradientenmatrix 
abgespeichert. 

60 Die Messvektoren miissen zusammen fiir jeden Freiheits- 
grad, in dem die Vorfaalteposition des Manipulators des 
Handhabungsgerats geregelt wird, mindestens ein unabhan- 
giges Messdatum enthalten. GemaB dner weiteren bevor- 
zugten Ausfuhrungsform der Erfindung wird voigeschlagen, 

65 dass die Messvektoren zusammen mindestens secfas Mess- 
daten enthalten. Dadurcfa kann die Position und Ausricfatung 
des Manipulators relativ zu dem Objekt in sechs Freiheits- 
graden eindeutig charakterisiert werden. Damit kann die 
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Vorhalteposition des Manipulators um sechs Freiheitsgrade 
im drcidiniensionalen Raum geregelt werden. Vorzugsweise 
enthalten die Messvektoren jeweils 32 Messdaten. 

Eine weitere Aufgabe der vorlicgenden Erfinduog besteht 
darin, eine Vorrichtung der eingangs genannten Art dahinge- 
hend auszugestalten und weiterzubilden, dass eine m6g- 
lichst schnelle Regelung der VDrhalteposition erreicht und 
dass insbesondere hdhere Verfahtgeschwindigkeiten des 
Manipulators auf der Verfahrbaha realisiert werden k5nnen, 
ohne dass es zu einem ^^rlust an Regelungsgenauigkeit 
kommt 

Zur Ldsung dieser Aufgabe schlagt die Erfinduog ausge- 
bend von der M^nicbtung der eingangs genannten Art vor, 
dass die Vorrichtung Mittel zur DuichfUhrung des X^rfah- 
rens nach einem der Anspriiche I bis 13 aufweist 

Eine wdtere Aufgabe der vorliegenden Erfindung besteht 
schlieBlich darin, ein Handhabungsgerat der eingangs ge- 
nannten Art dahingehend auszugestalten und weiterzubil- 
den, dass eine moglichst schnelle Regelung der Vorhaltepos* 
ition erreicht und dass insbesondere hdhere Verfahrge- 
schwindigkeiten des Manipulators auf der Verfahrbahn rea- 
lisiert werden konnen, ohne dass es zu einem Verlust an Re- 
gelungsgenauigkeit kommt 

Zur Losung dieser Aufgabe schlagt die Erfindung ausge- 
hend von dem Handhabungsgerat der eingangs genannten 
Art vor, dass das Handhabungsgerat Mittel zur DuichfUh- 
rung des Verfahrens nach einem der Anspriiche 1 bis 13 auf- 
weist 

Die erfindungsgemafie V>mchtung und das erfindungsge- 
maBe Handhabungsgerat wdsen insbesondere Mittel auf, 
um in einem Record-Mode mehrere Punkte zumindest eines 
Teils der 1st- Verfahrbahn zu speichem und die gespeicherten 
Punkte dann in einem Operation-Mode fur eine voraus- 
schauende Regelung der Vorhalteposition des Manipulators 
entlang dieses Teils der Verfahrbahn heranzuriehen, Des 
Weiteren weisen die erfindungsgemaSe VorrichOing und das 
erfindungsgemaBe Handhabungsgerat Mittel auf, um in ei- 
nem Parameter-Mode im Rahmen einer Trainingsphase den 
Manipulator in eine Soli- Vorhaiteposidon zu fahren, um den 
Manipulator um die einzelnen Freiheitsgrade des Handha- 
bungsgerats in andere Vorbaltepositionen zu verfahien und 
fur jeden Fieiheitsgrad in jeder \^rbalteposidoo die Mess- 
daten aufzunehmen und zu speichem, durch die die entspre- 
chende \^rfaalt^x)sition cfaarakterisiert ist 

Bei der erfindungsgemaBen \brrichtung und dem erfin- 
dungsgemafien Handhabungsgerat kann die \%rfahige- 
schwindigkeit des Manipulators aufgrund der vorausschau- 
enden Regelung besonders groB gewahlt werden. AuBenjem 
ersetzt die Trainingsphase das Einrichten und Kaiibrieren 
der Sensoren. Mit der erfindungsgemaBen M)rrichtung und 
dem erfindungsgemaBen Handhabungsgerat ist somit eine 
schnellere Regelung der Vbrhalteposidon mdglich, ohne 
dass es zu einem Verlust an Regelungsgenauigkeit kommt 

GemaB einer vorteilhaften Weiterfoildung der vorliegen- 
den &findung wird voigeschlagen, dass an dem Manipula- 
tor des Handhabungsgerats zur Ermitdung der Ist-\brhalt- 
eposition des Manipulators reladv zu dem Objekt ndnde- 
stens ein Sensor befestigt ist. 

Der Oder jeder Sensor ist voiteilhafterweise derart lelativ 
zu dem Objekt angeordnet, dass die Folge der Mesisdaten 
der fQr einen Freibeitsgrad aufgenonimenen Messvektoien 
streng monoton ist Dies ist eine wichdge Voraussetzung, 
um den Manipulator aus alien Posidoiien und Ausrichtun- 
gen relativ zu dem Objekt stets in die gewiinschte Soll-\br- 
halteposition regeln zu konnen. 

Des Weiteren muss die Beobachtbarkeitder Regelung si- 
cheigestelltsein. Deshalb wild gemaB einer anderen vorteil- 
haften Ausfuhmngsform der Erfindung vorgeschlagen, dass 



der Oder jeder Sensor derart reladv zu dem Objekt angeord- 
net ist, dass in der Gradientenmatrix fiir jeden Freibeitsgrad 
jeweils fUr mindestens einen aufgenommenen Messdaten 
ein Gradienten-Betragswert enthalten ist 
5 Damit die in der Gradientemnadix im Rahmen der Rege- 
lung der Vorhalteposition auch verarbeitet werden konnen, 
und zu einem zuverlassigen Ergebnis fuhren, wird voige- 
schlagen, dass der oder jeder Sensor derart relativ zu dem 
Objekt angeordnet ist, dass die Gradienten-Betragswerte in 

10 der Gradientenmatrix signifikant sind. Man ^richt von si- 
gnifikanten Gradienten-Betragswerten, wenn diese von dem 
Messrauschen der aufgenommenen Messdaten unterscheid- 
bar sind. Die Gradienten-Betragswerte sind bspw. unter- 
scheidbar, wenn sie etwa doppelt so groB sind wie das Mess- 

15 rauschen der aufgenommenen Messdaten. Falls die Gra- 
dientenstarke nicht ausreichend grofi ist, wird der entspre- 
chende Gradienten-Betragswert ds nicht vorhanden gewer- 
tet. Die Gradienten-Betragswerte in der Gradientenmatrix 
sind vorzugsweise in etwa mindestens dieimal so groB wie 

20 das Messrauschen. 

Die Kriterien der Monotonie der Folge der Messdaten, 
der Beobachtbarkeit der Regelung und der Gradientenstarke 
konnen durch die Position der Sensoren relativ zu dem Ma- 
nipulator beeinflusst werden. Der genaue Bezug der Senso- 

2S ren zu dem Manipulator ist alleidings von unteigeotdneter 
Bedeutung, soiange die o. g. Kriterien erfQUt sind. Der Be- 
zug der Sensoren zu dem Manipulator wird wahrend der 
Trainingsphase erfasst und iiber die aufgenommenen und 
abgespeicherten Messdaten in der Regelung beriicksichtigt 

30 GemaB einer bevorzugten AusfUhrungsform der vorlie- 
genden Erfindung wird vorgeschlagen, dass der oder jeder 
Sensor als ein optischer Sensor, insbesondere als eine CCD- 
Kamera, ausgebildet ist Mittels CCD-Kameras kann ein 
Objekt auf vielfaltige Weise charakterisiert werden. Es ist 

35 denkbar, dass die Messdaten bei als CCD-Kameras ausge- 
bildeten Sensoren als Abstande zwischen den Sensoren und 
dem Objekt, als Pixel auf dem CCD-Chip o. a. ausgebildet 
sind. CCD-Kameras haben zudem den Vorteil, dass ihr 
Blickfeld zum Ausrichten der Sensoren relativ zu dem Ob- 

40 jekl auf einem Bildschirm dargestellt werden kann. Das er- 
leichtert die Ausrichtung der Sensoren erheblich. 

Ein bevorzugtes Ausfuhrungsbeispiel der vorliegenden 
Erfindung wird im Folgenden anhand der Zeichnung naber 
eriautert Es zeigt 

45 F^. 1 ein erfindungsgemafies Handhabungsgerat gemaB 
einer bevorzugten Ausfiihrungsform; 

Fig. 2 den Manipulator des Handhabungsgerats aus F^. 1 
im Ausschnitt; imd 
Fig. 3 eine Verfahrbahn eines erfindungsgemaBen Hand- 

50 habungsgerats. 

In Fig. 1 ist ein erfindungsgemaBes Handhabungsgerat in 
seiner Gesamtheit mit dem Bezugszeichen 1 gekennzeich- 
net. Das Handhabungsgerat 1 weist einen Manipulator 2 auf, 
der in sechs Freiheitsgraden (x, y, z, a, b, c) bewegbar ist 

55 Das Handhabungsgerat 1 ist bspw, als ein Industrie-Roboter 
ausgebildet, dessen Manipulator 2 bspw. als ein beliebiges 
Werkzeug oder als ein Messkopf zur Aufnahme beliebiger 
MessgroBen (Temperatur, Abstand, etc.) ausgebildet ist 
Damit der Manipulator 2 die ihm zugedachte Aufgabe er- 

60 fiillen kann, muss er in dne definierte \brhalteposition (vgi. 
Fig. 2) relativ zu einem Objekt 3 gebracht werden. Unter 
dem Begriff Vorhalteposition wird gemafi dem voriiegenden 
Patent auch die Ausrichtung des Manipulators 2 relativ zu 
dem Objekt 3 verstanden. Die Erfindung schlagt ein Verfah- 

65 ren zur Regelung der Vorhalteposition vor. Das erfindungs- 
gemaBe Verfahren kann nicht nur fur jede Art von Pick-and- 
place-Anwendungen, sondem auch fUr Anwendungen, bei 
denen einem bestimmten Linienverlauf gefolgt werden 
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muss, bspw. zum SchweiBen, Kleben odcr Abdichten von 
Kanten, eingesetzt werden. 

Gemafi dem vorliegenden Austiihrungsbeispiel soil ein 
Schiebedach 4 eines Kraftfahrzeugs von dem Manipulator 2 
ergriffen und in cine entspnechende Offiiung (Objekt 3) im 5 
Dach 5 der Karosserie des Kraftfahrzeugs eingesetzt wer- 
den. Der Manipulator 2 ist als ein Saugnapf zum Greifen des 
Schiebedachs 4 ausgebildet Die Voifaalteposition ist eine 
Position oberfaalb der Oflhung, von der aus das Schiebedach 
4 in einer garadlinigen» senkrechten Bewegung nach unten to 
in die Ofihung bewegt werden kann. 

Das Handhabungsgerat 1 weist eine interne Steuerungs- 
dnrichtung 6 auf. Auf der Steuerungseinricbtung 6 ist ein 
Steueningspiogranun lauffahig, durch das der Manipulator 
2 enllang einer programmierten Verfahrbahn (vgl. Fig, 3) in 15 
die Voriiaiteposition bewegt werden kann. Wenn das Objekt 
3, im vorliegenden AusfOhrungsbeispiel die Oftnung im 
Dach 5 der Karosserie des Kraftfahrzeugs, stets an derselben 
Position angeordnet ist, reicht eine solche Steuerung der 
Verfahrbahn bis zur Vorhalteposition vollkommen aus. Falls 20 
die Position des Objekts 3 jedoch gewissen Schwankungen 
unterworfen ist, kann durch eine Steuerung alleine nicht 
mehr sicbeigestellt werden, dass eine bestimmte Vorhalt- 
eposition des Manipulators 2 relativ zu dem Objekt 3 stets 
mit der erforderlichen Genauigkeit eingenommen wild. 25 
Schwankungen des Objekts 3 konnen sich bspw. aufgnind 
von Ungenauigkeiten bei der Positionierung der Karosserie 
reladv zu dem Handhabungsgerat 1 oder aufgniod der Be- 
wegung der Karosserie des Kraftfahrzeugs auf einer Ferti- 
gungsstraBe ergeben, 30 

Um sicherzustellen, dass die Vorhalteposition des Mani- 
pulators 2 relativ zu dem Objekt 3 auch bei Schwankungen 
der Position des Objekts 3 stets milder geforderten Genau- 
igkeit eingenommen wird, wird in solchen Fallen die 
haltepQsition des Manipulators 2 reladv zu dem Objekt 3 ge- 35 
regelt Aus dem Stand der Technik sind mehrere Verfahren 
zur Regeiung der NA^rhalteposidon des Manipulators 2 be- 
kannt Diese Verfahren sind jedoch sehr arfoeits- und zeitauf- 
wendig. 

Das erfindungsgemafie Verfahren zur Regeiung der Vdt- 40 
balteposidon des Manipulators 2 weist verschiedene Merk- 
male zur Beschleunigung und Verdnfachung der Regeiung 
auf. Das Verfahren ist auf einer extemen Regelungseinrich- 
tung 7 implementieit (vgL Fig. 1). Die Regelungseinrich- 
tung 7 ist als ein herkommlicher Personal-Computer (PC) 45 
oder Industrie-PC ausgebildet. Auf der Regelungseinrich- 
tung 7 ist ein Regelungsprogramm, das in einer herk5mmli- 
chen Programmiersprache programmiert ist, lauffahig. In 
Fig. 1 ist die Regelungseinrichtung 7 als von dem Handha- 
bungsgerat 1 getrennt ausgebildet. £s ist jedoch auch denk- 50 
bar, dass die Regelungseinrichmng 7 in das Handhabungs- 
gerat 1 integriert ist Das Steuerungsprogramm der Steue- 
rungseinrichtung 6 ist in einer proprietaren, nur auf der 
Steuerungseinrichtung 6 dieses Handhabungsgerats 1 lauf- 
fahigen Pinogrammiersprache programmiert Das Steue- ss 
rungsprogramm weist an bestimmten Stellen Programmier- 
befehie (Aufrufbefehle, RUckbolbefehle) auf, um das Rege- 
lungspiogramm der extemen Regelungsvorrichtung 7 von 
dem Steuerungsprogramm aus aufzurufen bzw. um von dem 
Regelungsprogramm wieder zu dem Steuerungsprogramm 60 
zuriickzukehien. Zwischen der Steuerungseinrichtung 6 und 
der Regelungseinrichtung 7 ist eine Datenleitung 8 zum 
Austausch von Daten voigesehen. 

In Fig. 2 ist zu erkennen, dass an dem Manipulator 2 vter 
als CXJD-Kamcras ausgebildete Sensoren 9 angeordnet sind, 65 
Durch die Sensoren 9 werden die Verlaufe der Kanten 10 in 
Relation zu dem Manipulator 2 gesetzt Dazu werden Mess- 
daten, die im vorliegenden AusfUhningsbeispiel als Pixei- 



werte der CCD-Chips der Sensoren 9 ausgebildet sind, auf- 
genommen und in Messvektoren gespeichett 

Das erfindungsgemafie Verfahren zur Regeiung der Vor- 
halteposition des Manipulators 2 relativ zu dem Objekt 3 
weist drei unterschiedliche Betriebszust^de auf. In einem 
ersten Betriebszustand, dem sog. Record-Mode, wird die 
Verfahrbahn A bis B (vgL Fig. 3) zu einer Vorhalteposition 
hin und von der Vorhalteposition weg von dem Steuenings- 
programm der Steuerungseinrichtung 6 gesteuert abgefah- 
len. In dem Bereich der Verfahrtiahn zwisdien den Punkten 
C und D liegt ein fiir die Regeiung interessanter Bereich mit 
dnem oder mehreren ^Maltepositionen des Manipulators 
2, die relativ zu dem Objekt 3 geiegelt wcfden soUen. ^nn 
der Manipulator 2 betm Abfabren der Verfahibahn den 
Punkt C erreicht hat, wird das Regelungsprogramm der Re- 
gelungseinrichtung 7 aufgerufen, Wahrend des gesteuerten 
Abfahrens der Verfahrbahn von dem Punkt C bis D werden 
dann einer oder mehrere Punkte von dem Regelungspro- 
gramm aufgenommen und gespdchert. Wenn die Verfahr- 
bahn den Punkt D erreicht hat, wird das Regelungspro- 
gramm beendet Damit ist der Record-Mode beendet. Auf 
die gespeicherten Punkte der Verfahrbahn wird dann in ei- 
nem dritten Betriebszustand der Regeiung zugeg;rifien. 

In einem zweiten Betriebszustand, dem sog. Parameter- 
Mode, fahrt der Manipulator 2 von dem Steueningspro- 
gramm gesteuert die Verfahrbahn von dem Punkt A zu dem 
Punkt C ab. Wenn die Verfahrbahn den Punkt C meicht hat, 
wird das Regelungsprogramm aufgerufen, und die Steue- 
rung des Manipulators 2 wird von dem Steuerungspro- 
gramm an das Regelungsprogramm abgegeben. Das Rege- 
lungsprogramm fahn die gespeicherte Verfahrbahn zwi- 
schen den Punkten C und D ab. Auf der Verfahrbahn werden 
diejenigen Vorhaltepositionen angefahren, die relativ zu 
dem Objekt geregelt werden soUen, und fiir jede Vbrhalt- 
eposition wird eine Trainingsphase durchlaufen. Wenn die 
von dem Regelungsprogramm gesteuerte Verfahrbahn den 
Punkt D erreicht hat, wird das Regelungsprogramm beendet 
und die Steuerung des Manipulators 2 entlang der Verfahr- 
bahn wieder an das Steuerungsprogranun zuriickgegeben. 
Der Manipulator 2 fahrt dann von dem Steuerungspro- 
gramm gesteuert die restliche Verfahrbahn von dem Punkt D 
bis B ab. Damit ist der Parameter-Mode beendet 

FQr jede Vorhalteposition, die relativ zu dem Objekt 3 ge- 
regelt werden soil, wird eine IVainingsphase durchgefiihrt. 
Dazu wird zunachst die Soil- Vorhalteposition mit dem Ma- 
nipulator 2 angefahren, und von den Sensoreii 9 werden die 
Werte von 32 Messdaten, durch die die Soli- Vorhaltepos- 
ition charakterisiert ist, aufgenommen und in dnem SoU- 
Messvektor y_soll gespeichert. Der Soll-Messvektor y_soll 
hat somit die Dimension 32 x 1 (32 Messdaten x I Wert). 
AnschlieBend wird der Manipulator 2 nacheinander um je- 
den der sechs Freihdtsgrade in fUnf Vorhaltepositionen in 
der einen Richtung der Soil- Vorhalteposition und in funf 
Vbrhaltepositionen in der anderen Richtung der SoU- Vor- 
halteposition bewegt In jeder Vorhalteposition werden die 
entsprechenden Werte der 32 Messdaten aufgenommen und 
in Messvektoren gespeichert Aus den zehn Messvektoren 
und dem Soll-Messvektor y.soll wird dann fur jeden der 
sechs Freiheitsgrade der Be^ des Gradienten eines be- 
stimmten Messdamms berechnet und in einer Gradienten- 
matrix C abgespeichert. Die Gradientenmatrix C hat somit 
die Dimension 32 x 6 (32 Messdaten X 6 Freiheitsgrade). 
Fiir jeden der zu regelnden Vorhaltepositionen erhalt man 
somit einen SoU-Messvektor y_soll und die Gradientenma- 
tnx C. 

In einem driuen BeUiebszustand, dem sog. Operation- 
Mode, fahrt der Manipulator 2 von dem Steuerungspro- 
gramm gesteuert die Verfahrbahn von dem Punkt A zu dem 
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Punkt C ab. Wenn die Verfahrbahn den Punkt C erreicht hat, 
wird das Regelungsprogramm aufgerufen, und die Steue- 
rung des Manipulators 2 wird von dem Steuerungspro- 
gramm an das Regelungsprogramm abgegeben. Das Rege- 
lungsprogramm fahrt die gespeicherte Verfahrbahn zwi- 5 
schen den Punkten C und D ab. Die gespetcheiten Punlcte 
der Verfahrbahn eilauben eine vorausschauende Regelung 
der Vorfaaltepunkte auf der Verfatubahn, was bei gleicher 
Oder sogar hdherer Geaauigkeit eine wesentiich hdheie Ver- 
fahrbahngeschwindigkeit als bei den aus 'dem Stand der 10 
Technik bekannten Verfahren zum Regeln der Vorhaltepos- 
ition eines Manipulators ermoglicht 

In dem Bereich der Verfahrbahn zwischen den Punkten E 
und F liegt ein fiir die Regelung interessanter Bereich mit ei- 
nem oder mehieren Vorfaalteposidonen des Manipulators 2, IS 
die relativ zu dem Objekt 3 geregelt werden sollen. Sobald 
die Verfahrbahn den Punkt E erreicht hat, erfolgt eine Rege- 
lung der Vorhalteposition auf der Verfahrbahn. Im Rahmen 
6&r Regelung der Vorhalteposition werden von den Senso- 
rea 9 zunachst in der momentanen 1st- Vorhalteposition die 20 
entspiechenden Werte der Messdaten aufgenommen und in 
einem Ist-Messvektor y.ist gespeicliert Der Ist-Messvektor 
y_ist bat ebenfaUs die Dimension 32 X 1 (32 Messdaten x 1 
Wert). Aus der DifTerenz des Soll-Messvektois und des Ist- 
Messvektors wtid ein Differenz-Messvektor D_y gebildet 25 
(D_y = y soli - y_ist). Der Differenz-Messvektor D_y hat 
ebenfalls die Dimension 32 X L Daim wud der Kehrweit 
der Gradientenmatrix C berechnet und wahlweise abgespei- 
chert Aus dem Produkt des Kehrwerts des Gradientenvek- 
tors C und des Differenz-Messvektors D_j wird ein Koirek- 30 
turvektor D_x ermittelt, der ebenfalls die Dimension 32 X 1 
haL Es ist jedoch auch denkbar, dass der Korrekturvektor 
D_x mitteis eines anderen geeigneten Verfahrens, bspw. 
durch den Einsatz eines sequentielien Kalmanfilt^s, ermit- 
teltwird 35 

Ein Tbil des Korrekturvektors D_x, vorzugsweise etwa 
10% des Korrekturvektors D_x, wird zur Korrektur der Ist- 
Vorhalteposition des Manipulators 2 herangezogen. In der 
neuen I^-^^rhalteposition werden emeut die entsprechen- 
den Werte der M^sdaten aufgenonunen und in einon Ist- 40 
Messvektor y_ist gespeichert. Wie oben bereits bescfarieben 
wird emeut ein Korrekturvektor D_x berechnet und die Ist- 
Vorhaltepositioo in Abhangigkeit von dem Korrekturvektor 
D_x konigiert. Die Korrektur der Ist-Nforhalteposition wird 
so lange wiederholt, bis die einzelnen Werte des Korrektur- 45 
vektors D_x ein bestimmtes Abbruchkriterium erfiillt ha- 
ben, d. h. bis der Manipulator 2 auf die Soll-Vorhaltepos- 
ition geregelt isL 



Patentanspruche 
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1. Verfahien zur Regelung der Vorhalteposition eines 
in mehreren Freiheitsgraden bewegbaren Manipulators 
(2) eines Handhabungsgerats (1) relativ zu einem Ob- 
jekt (3) endang einer Verfahrbahn, dadurch gekcnn- 55 
zeichnet, dass mehrere Punkte zumindest eines T&ils 
der Ist- Verfahrbahn gespeichert sind und fiir eine vor- 
ausschauende Regelung der Vorhalteposition des Ma- 
nipulators (2) endang dieses Teils der Verfahrbahn her- 
angezogen werden. ^ 

2. Verfahren nach Anspruch 1, dadurch gekennzeich- 
net, dass die Ist- Verfahrbahn des Manipulators (2) vor 
der Regelung der Vorhalteposition abgefahren wird 
und dabei die Punkte zumindest eines Teils der Ist- Ver- 
fahrbahn aufgenonunen und abgespeichert werden. 65 

3. Verfahren nach Anspruch 2. dadurch gekennzeich- 
net, dass die Ist- Verfahrbahn von dem Manipulator (2) 
vor der Regelung der Vorhalteposition von einer inter- 



nen Steuerungseinrichtung (6) des Handhabungsgerats 

(1) gesteuert abgefahren wird. 

4. Verfahren nach Anspruch 2 oder 3, dadurch gekenn- 
zeichnet, dass die Punkte zumindest eines Teils der Ist- 
Verfahrbahn von ein^ extemen Regelungseinrichtung 
(7) aufgenommen und abgespeichert werden. 

5. Verfahren nach Anspruch 3 und 4, dadurch gekenn- 
zeichnet, dass die exteme Regelungseinrichtung (7) 
von der intemen Steuerungseinrichtung (S) aufgerufen 
winL 

6. Verfahren zur Regelung der Vorhalteposition eines 
in mehreren Freiheitsgraden bewegbaren Manipulators 

(2) eines Handhabungsgerats (1) relativ zu einem Ob- 
jekt (3) endang einer Verfahrbahn, insbesondere nach 
einem der Anspruche 1 bis 5, dadurch gekennzeichnet^ 
dass die SoU-Vorfaalteposidon des Manipulators (2) vor 
der Regelung der Vorhalteposition angefahren wird, 
wahrend einer Veranderung der Soli- Vorhalteposition 
um jeweils einen Freiheitsgrad Messdaten, durch die 
die Vorhalteposition des Manipulators (2) charakteri- 
siert ist, aufgenommen und gespeichert werden und die 
Regelung der Vorhalteposition in Abhangigkeit von 
dra Messdaten durchgefiihit wird. 

7. Verfahren nach Anspruch 6, dadurch gekennzeich- 
net, dass vor der Regelung der Vorhalteposition 

~ die SoU-^ferfaalteposition angefahren wird, 

- ein SoU-Messvektor (y_soll) mit den Messda- 
ten aufgenommen wird, 

- fiir jeden Freiheitsgrad der Manipulator (2) des 
Handhabungsgerats (1) aus der SoU- Vorhaltepos- 
ition heraus in mehrere Vorhaltepositionen be- 
wegt und in jeder Vorhalteposition ein Messvektor 
aufgenommen wird, 

- fur jeden Freiheitsgrad fiir dieselben Messdaten 
der Messvektoren der BeUrag des Gradienten er- 
mittelt und in einer Gradientenmatrix (C) gespei- 
chert wird, und im Rahmen der Regelung der Vor- 



- ein Korrekturvdctor (D_x) aus der Multiptika- 
tion des Kehrwerts d^ Gradientenmatrix (Q mit 
der DifTerenz des SoU-Messvektors (y_soll) und 
eines Ist-Mcssvektors (y_ist) in der Ist- Vorhalt- 
eposition des Manipulators (2) oder anhand eines 
anderen geeigneten Verfahrens ermittelt wird und 

- die Vorhalteposition in Abhangigkeit von dem 
Korrekturvektor (D_x) geregelt wird. 

8. Verfahren nach Anspruch 7, dadurch gekennzeich- 
net, dass die Ist- Vorhalteposition des Manipulators (2) 
im Rahmen der Regelung der Vorhalteposition um ei- 
nen Bruchteil des Korrekturvektors (D_x) korrigiert 
wird und anschlieBend der Ist-Messvektor (y_ist) in der 
konigierteo Ist-\^halteposition und daraus der Kor- 
rekturvektor (D.x) emeut ermittelt wird. 

9. Verfahren nach Anspruch 8, dadurch gekennzeich- 
net, dass die Regelung der Vsrhalteposition abgebro- 
chen wird, wenn jedes der Elemente des Korrekturvek- 
tors (D__x) kleiner als ein Abbruchkriterium ist 

10. Verfahren nach Anspruch 8 oder 9, dadurch ge- 
kennzeichnet, dass fiir jeden Freiheitsgrad von der 
Soil- Vorhalteposition aus mindestens zwei Messvekto- 
ren in jede Richtung aufgenommen werden. 

11. Verfahren nach Anspruch 10, dadurch gekenn- 
zeichnet, dass fiir jeden Freiheitsgrad von der Soil- Vor- 
halteposition aus funf Messvektoren in jede Richtung 
aufgenommen werden. 

12. Verfahren nach einem der Anspruche 1 bis 5, da- 
durch gekennzeichnet, dass die Messvektoren zusam- 
men mindestens sechs Messdaten enthalten, damit die 
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Position und Ausrichtung des Manipulators (2) leladv 
zu dem Objekt (3) im dieidimensioDalen Raum cfaarak- 
terisieit isL 

13. Verfahren nach Ansprucfa 12, daduich gekenn- 
zeichnet, dass die Messvektoien jewdls 32 Messdaten 5 
enthalten. 

14. Vomchtung zur Regelung der V^rhalteposition ei> 
nes in mehreren Freiheitsgradea bewegbaien Manipu- 
lators (2) eines Handhabungsger^ (1) reladv zu einem 
Objekt (3) entlang einer Verfahibahn, daduich gekenn- lO 
zeichnet, dass die Vorrichtung Mittel zur Durcbfuhrung 
des Verfahrens nach einem der Ansphiche 1 bis 13 auf- 
weist. 

15. HandhabungsgerM(l)init einem in mehierenFieir 
heitsgraden bewegbaren Manipulator (2), dessen M)r- tS 
halteposition lelativ zu einem Objekt (3) cegelbar ist, 
dadurch gekennzeichnet, dass das Handhabungsgerat 
(9) Mittel zur DurchfQhning des Verfahcens nach ei« 
nem der Anspruche 1 bis 13 aufweist. 

16. Handhabungsgerat (1) nach Anspruch 15, dadurch 20 
gekennzeichnet, dass an dem Manipulator (2) des 
Handhabungsgerats (1) zur Ermittlung der Ist-Vorhalt- 
eposition des Manipulators (2) reladv zu dem Objekt 
(3) mindestens ein Sensor (9) befestigt isL 

17. Handhabungsgerat (1) nach Anspruch 16, dadurch 25 
gekennzeichnet, dass der oder jeder Sensor (9) derart 
relativ zu dem Objekt (3) angeordnet ist, dass die Folge 
der Messdaten der fOr einen Fteiheitsgrad aufgenom- 
menen Messvektoien streog monoton ist 

18« Handhabungsgerat (1) nach Anspruch 17, daduich 30 
gekennzdchnet, dass in der Gradientenmatrix (C) fur 
jeden Freiheitsgrad jeweils fiir mindestens ein aufge- 
nonunenes Messciatum ein Gradienten-Betragswert 
enthalten ist. 

19. Handhabungsgerat (1) nach Anspruch 18, dadurch 35 
gekennzeichnet, dass die Gradienten-Betragswerte in 
der Gradientenmatrix (C) signifikant sind. 

20. Handhabungsgerat (1) nach einem der Anspriiche 
15 bis 19, dadurch gekennzeichnet, dass der oder jeder 
Sensor (9) als ein optischer Sensor ausgebildet ist 40 

21. Handhabungsgerat (1) nach Anspruch 20, dadurch 
gekennzdchnet, dass der oder jeder Sensor (9) als eine 
CCD-Kamera ausgebildet ist 
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